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(54) APPARATUS FOR CONTROLLING MOVEMENT OF ROBOT AND METHOD OF CONTROLLING 
MOVEMENT OF ROBOT 



(57) A tool (12) is moved by the jog-feed by a jog- 
feed command means toward a position (Pa) to which a 
teaching point is to be corrected. When the position of 
the tool approaches any teaching point (Pt) in a move- 
ment command program, a robot is automatically 
shifted to the teaching point Pt Thus, an operator can 
recognize that the position, in which the robot is stopped 
is the teaching point (Pt) to be corrected in the move- 
ment command program. When the teaching point (Pt) 
to be corrected is found, correction of a teaching point 
from the point (Pt) to the position (Pa) to be corrected is 
performed according to the same method as the con- 
ventional method. 
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Description 

TECHNICAL FIELD 

This invention relates to a robot movement control 
device and a robot movement control method to correct 
a teaching point set in a program to another position 
according to the movement of a tool. 

BACKGROUND ART 

In conventional control of an industrial robot, an 
operator teaches a target point for the movement of a 
tool attached to the end of a robot arm, and a robot is 
moved according to a program generated so that the 
robot reaches this teaching point Such a teaching point 
specified by the program is sometimes deviated from a 
set point as the result of varying the position or direction 
of a workpiece during work. In this case, it is necessary 
to correct the teaching point deviated from the set point, 
as a matter of course. 

When correction of a teaching point is performed in 
conventional robot control device, a command block of 
the teaching point is specified on the screen of a teach- 
ing pendant, and the robot is moved to the specified 
teaching point, and is further moved by jog-feed from 
the specified teaching point to a corrected teaching 
point. When the robot reaches the corrected teaching 
point, a coordinate point of the command block is auto- 
matically corrected by instructing correction on the 
teaching pendant. 

However, the conventional robot control device 
described above has needed to find the correspond- 
ence between a teaching point to be corrected and its 
command block. Evenifthiscorrespondenceisfound.it 
is necessary to alternate execution of a program and 
jog-feed operation with each other, and as a result 
working efficiency is degraded. 

DISCLOSURE OF THE INVENTION 

ft is an object of the present invention to provide a 
robot movement control device and a robot movement 
control method, which enable correction of a teaching 
point easily with accuracy. 

In order to attain the above object as one mode of 
a robot movement control device according to the 
present invention, there is provided a robot movement 
control device which moves a robot tool to a predeter- 
mined teaching point and comprises a program storage 
means for storing a program to instruct the robot to be 
moved to the predetermined teaching point a jog-feed 
command means for instructing the robot to be moved 
by the jog-feed, a jog-feed control means for moving the 
robot by the jog-feed in the direction instructed by the 
jog-feed command means, and a teaching-point direc- 
tional movement control means for watching the posi- 
tion of the robot moved by the jog-feed, and instructing 
the jog-feed control means to shift the robot to a teach- 



ing point to which the robot comes closer, when the 
robot approaches any teaching point in the movement 
command program. 

Preferably, the teaching-point directional movement 
5 control means is configured to shift the robot tool after 
the tool is reoriented to a posture instructed by the pro- 
gram. 

As another mode of the robot movement control 
device according to the present invention, there is pro- 

10 vided a robot movement control device which moves a 
tool of a robot to a predetermined teaching point and 
comprises a program storage means for storing a pro- 
gram to instruct the robot to be moved to the predeter- 
mined teaching point, a jog-feed command means for 

is instructing the robot to be moved by the jog-feed, a jog- 
feed control means for moving the robot by the jog-feed 
in the direction instructed by the jog-feed command 
means, a shifting command means for instructing the 
robot to be shifted to a predetermined teaching point, 

20 and a teaching-point directional movement control 
means for instructing the jog-feed control means to shift 
the robot to a teaching point, which is the closest to the 
position of the robot among teaching points in the move- 
ment command program, when the instruction to shift 

26 the robot is performed. 

Further, in a robot movement control method 
according to the present invention, a teaching-point 
move mode is set in a control device for controlling a 
robot When the control device enters this teaching- 

30 point move mode by switching operation to move a tool 
attached to the end of a robot arm by the jog-feed 
toward a target position to which the teaching point is to 
be corrected a numerical control unit decides during the 
jog-feed as to whether or not the current position of the 

35 tool is within the range of a predetermined distance 
from a programmed teaching point When decided that 
the current position of the tool is within the predeter- 
mined range, the tool is forcibly shifted to the pro- 
grammed teaching point and is positioned at the target 

40 teaching point to be corrected. Further, when the cur- 
rent position of the tool is within the predetermined 
range of the programmed teaching point the tool is 
shifted to the teaching point after the tool is reoriented 
to the direction taught in the programmed teaching 

45 point 

According to the present invention, first the tool is 
moved in the direction commanded by the jog-feed 
command means. When the tool approaches any 
teaching point in the movement command program, the 

so robot is operated to shift the tool to the teaching point 
As a result, an operator is able to judge a position, in 
which the robot is stopped, to be one of teaching points 
in the movement command program Further, if the tool 
is fed by jog-feed from this teaching point to a position to 

55 be set as a new teaching point, it is possible to correct a 
teaching point from a programmed teaching point to a 
target point for the movement of the tool. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a conceptual view for explaining the func- 
tion of one embodiment according to the present 
invention; 

Fig. 2 is a view showing the overall configuration of 

a robot control system including a robot movement 

control device according to the embodiment; 

Fig. 3 is a block diagram showing the hardware 

configuration of a robot control device; 

Fig. 4 is a view showing the schematic configuration 

of a panel face of a teaching pendant; 

Fig. 5 is a view showing the operation of a tool of a 

robot; and 

Fig. 6 is a flowchart showing a procedure on the 
side of a robot control device for controlling the 
movement of a robot according to the embodiment. 

BEST MODE FOR EMBODYING THE INVENTION 

First of all, a description will be given of the outline 
of a function according to an embodiment of the present 
invention with reference to Fig. 1. A program 1a to 
instruct a robot to be moved to a predetermined teach- 
ing point is stored in a program storage means 1 . A jog- 
feed control means 3 moves a robot by jog-feed in the 
direction instructed by a jog-feed command means 2. 
For instance, the jog-feed control means 3 moves a tool 
4a along a jog command route L11. A teaching-point 
directional movement control means 5 watches the 
position of a robot 4 moved by jog-feed, and instructs 
jog-feed control means 3, when the tool 4a (that is, a 
tool center point) of the robot 4 approaches any teach- 
ing point Px, to shift the tool 4a of the robot 4 to the 
teaching point Px in the movement command program 
1a. Asa result the tool 4a goes out of the jog-command 
route L11 and is shifted toward the teaching point Px 
along a route L1 2. 

A description will now be given of the overall config- 
uration of a robot control system for embodying a robot 
movement control device as one embodiment of the 
present invention with reference to Fig. 2. A tool 12 is 
attached to the end of an arm 11 of a robot 10. The 
robot 10 is adapted to machine or carry a workpiece 20, 
and its operation is controlled by a robot control device 
30. The operation of the robot 10 is instructed by a 
teaching pendant 40 connected to the robot control 
device 30. The teaching pendant 40 has such a size as 
to make handy for an operator to carry. The teaching 
pendant 40 includes a liquid crystal cfisplay panel and 
various keys as will be described later. 

Fig. 3 is a block diagram showing the hardware 
configuration of the robot control device 30. The robot 
control device 30 includes a processor board 31. This 
processor board 31 includes a processor 31a, ROM 31b 
and RAM 31c. The processor 31a controls the entire 
robot control device 30 according to a system program 
stored in ROM 31b. Various data such as a movement 
command program of the robot 10 are stored in RAM 



31c. Coordinates of a teaching point and the direction 
(i.e., coordinates of an axis of rotation) of the tool 1 2 are 
stored in each command block of the movement com- 
mand program. Such a processor board 31 is con- 

5 nected to a bus 39. 

A digital servo control circuit 32 is connected to the 
bus 39, and drives servo motors 51, 52, 53, 54 and 55 
through a servo amplifier 33 according to the command 
from the processor board 31. These servo motors are 

io built in the robot 10 and operate each axis of the robot 
10. 

A serial port 34 is connected to the bus 39, and also 
connected to both the teaching pendant 40 with a dis- 
play and other RS232C apparatus 58. The teaching 

75 pendant 40 has a size to make handy for an operator to 
carry, as described above, and is provided with a jog- 
feed button and a teaching point correction button or the 
like on the panel. CRT display 36a may be optionally 
connected to the serial port, and it is possible to check 

20 the working state or the like on the CRT display 36a. 

A console panel 36b is connected to a digital I/O 
unit 35, and the movement of the robot 10 may be 
instructed at the position of the robot control device 30 
through the teaching pendant A drive portion to grip the 

25 tool 12 is connected to the digital I/O unit 35 which is 
able to instruct the gripping operation. When a machin- 
ing head for laser welding is used for the tool 12, for 
instance, a welding power supply is connected to an 
analog VO unit 37, and a welding voltage is instructed 

30 through the analog I/O unit 37. Teaching data and oth- 
ers are stored in a mass memory 38. 

Fig. 4 is a view showing the schematic configuration 
of a panel face of the teaching pendant 40. A display 
screen 41 is a liquid crystal screen, for instance, and 

ss detailed data or the like in the movement command pro- 
gram is selectively displayed by switching. A function 
key 42 is a key which selects a menu displayed on the 
lower end of the display screen 41. This function key 42 
also serves to perform switching to a teaching-point 

40 move mode and to instruct a correction of a teaching 
point A teaching pendant valid switch 43 is a switch 
which makes the operation of the teaching pendant 40 
invalid from valid and vice versa. 

An emergency stop button 44 is a button which 

45 stops the operation of the robot 10 in an emergency. A 
cursor key 45 is a key which moves a cursor cfi splayed 
on the display screen 41. A ten-key pad 46 includes 
numerical keys and other keys which enable the input 
and deletion of numerical values and characters 

so A jog-feed command means includes a shift button 
48 and jog-feed buttons 47. First either an orthogonal 
coordinate system (X, Y, Z) or each joint axis (J1 to J6) 
is selected by depressing a coordinate selection button 
49. In case where the orthogonal coordinate system is 

55 selected, if any one of the jog-feed 47 buttons indicating 
plus or minus linear direction for each of X, Y and Z axis 
is selectively depressed together with the shift button 
48, then the robot is moved by jog-feed in the selected 
direction for the selected axis. On the other hand, if any 
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one of the jog-feed buttons 47 indicating plus or minus 
rotational direction about each of X, Y and Z axis is 
selectively depressed together with the shift button 48, 
then the robot is moved by jog-feed in the selected rota- 
tional direction about a selected axis. Further, in case 5 
where individual joint-axis feed mode comes into effect 
by depressing the coordinating selection button 49, if 
any one of the jog-feed buttons 47 for each joint axis (J1 
to J6) is selectively depressed, then jog-feed of the 
robot for the selected joint axis is carried out 10 

A description will now be given of the specific 
processing contents of the robot movement control 
device as one embodiment of the present invention. 

Fig. 5 is a view showing the operation of the tool 12 
of the robot 10. In this case, a workpiece 20 is a thin is 
sheet, and the robot performs the operation of gripping 
this thin sheet (i.a, workpiece 20). A point Pt of the 
workpiece 20 is assumed to be a teaching point prede- 
termined in the movement command program. A 
description will new be given of a case where an 20 
attempt to shift the tool 12 to a point Pa is made in order 
that the point Pa close to the teaching point Pt is set as 
a new teaching point in place of the point Pt. 

First an operator depresses the jog-feed button 47 
on the teaching pendant 40 to shift the tool 12 (Le., a 25 
tool center point) toward the target point Pa (along the 
route L1). During the movement of the tool 12, the 
teaching-point directional movement control means 5 
watches at all times the position of the tool moved by the 
jog-feed. When the tool 12 enters the range of a prede- 30 
termined radius from the teaching point Pt during the 
shifting of the tool 12 toward the point Pa, the teaching- 
point directional movement control means 5 detects the 
approach of the tool 12. In this case, "the range of a pre- 
determined radius" means a distance set to be shorter 35 
to some extent than the distance between this point Pa 
and any other teaching point. 

The teaching-point directional movement control 
means 5 reorients the tool 12, at the detected position 
Pc, so that its direction is same as the direction sped- 40 
fied in the teaching point Pt Then this reoriented tool 12 
is shifted toward the teaching point Pt along the different 
track (along the route 12). When the tool 12 reaches the 
teaching point Pt, the tool 12 is stopped. When the tool 
center point of the tool 12 is stopped at the teaching 4s 
point Pt, the correction of the teaching point is per- 
formed according to a method similar to the conven- 
tional method. That is, the operator depresses the jog- 
feed button 47 to shift the tool to the target point Pa. 
When the tool reaches the point Pa, the correction of so 
the teaching point is instructed by depressing the func- 
tion key 42 or the like. As a result rewrite from the coor- 
dinate data of the teaching point Pt to the coordinate 
data of the point Pa is performed on the side of the robot 
control device 30. ss 

A description will now be given of the procedure in 
case where the processor 31a of the robot control 
device 30 performs the above operation with reference 
to the flowchart shown in Fig. 6. 



The function key 42 is depressed to switch a mode 
to the teaching-point move mode, and the jog-feed but- 
ton 47 is depressed to start a shifting control so as to 
shift a teaching point toward a position to be corrected 
(Step S1). An axis is controlled according to the 
selected coordinate system and the axis and its direc- 
tion corresponding to the depressed jog-feed button 47, 
and the jog-feed of the tool 12 is started (Step S2). ft is 
decided as to whether or not the jog-feed command is in 
the off state (Step S3). When the jog-feed command is 
not in the off state, it is decided as to whether or not the 
teaching-point move mode is selected (Step S4). When 
the teaching-point move mode is not selected, process- 
ing is returned to Step S3. On the other hand, when the 
teaching-point move mode is selected, it is decided as 
to whether or not the position of the jog-fed tool 12 is 
within the range of a predetermined radius (i.a, within 
the predetermined distance) from any teaching point in 
the movement command program (Step S5). When 
decided that the position of the tool 12 is outside the 
range of the predetermined distance, processing is 
returned to Step S3. On the other hand, when decided 
that the position of the tool 12 is within the range of the 
predetermined distance, then it is decided as to whether 
or not the tool 12 approaches the teaching point (Step 
S6). When decided that the tool approaches the teach- 
ing point processing is advanced to Step S7. On the 
other hand, when decided that the tool is moved away 
from the teaching point processing is returned to Step 
S3. 

That is, while the jog-feed command is in the on 
state, processing in Steps S3 to S5 is repeatedly exe- 
cuted. When the distance between the current position 
of the tool 12 and the teaching point is within the prede- 
termined range (Step S5), it is decided as to whether or 
not the tool approaches the teaching point by the jog- 
feed (Step S6). When decided that the tool approaches 
the teaching point by the jog-feed, processing is 
advanced to Step S7. In Step S7, the tool 12 is automat- 
ically reoriented to the direction as it is programmed in 
the above teaching point. Further, ft is decided as to 
whether or not the jog-feed command is in the off state 
(Step S8). When decided that the jog-feed command is 
not in the off state, then it is decided as to whether or not 
the tool 12 is completely reoriented (Step S9). Process- 
ing in Steps S8 and S9 is repeatedly executed until the 
tool 12 is completely reoriented. 

After the tool 12 is completely reoriented, the shift- 
ing of the tool 12 toward the teaching point Pt is auto- 
matically started (Step S10). Then, it is repeatedly 
decided as to whether or not the jog-feed command is in 
the off state, and whether or not the tool 12 reaches the 
target teaching point Pt when decided that the jog-feed 
command is not in the off state (Steps S11 and 12). 
When the tool 12 reaches the target teaching point Pt, 
the robot is stopped even if the jog-feed command is in 
the on state (Step S13). In this manner, when the oper- 
ation of the robot is stopped even if the jog-feed com- 
mand is in the on state, the tool 12 is regarded as 
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having reached the teaching point. Therefore, the cor- 
rection of the teaching point is afterward performed 
according to the same method as the conventional 
method. 

Incidentally, when the robot 10 is stopped before s 
the tool 12 exactly reaches its desired teaching point 
(i.e.. when the tool is stopped at a wrong teaching 
point), the jog-feed command is set to the on state to 
move the tool 12 away from the teaching point As a 
result processing in Steps S1 to S6 is executed. In this 10 
case, since the tool does not approach the teaching 
point in Step S6, processing is returned to Step 3. and 
the tool 12 is moved away from the teaching point as it 
is. Then, the tool is moved by jog-feed toward the 
desired teaching point and processing in Steps S1 to is 
S13 is executed to position the tool 12 at the desired 
teaching point. When the jog-feed command is set to 
the off state in Steps S3, S8 and S11 before the tool 12 
reaches the teaching point the movement of the robot 
is stopped. However, in this case, when the jog-feed 20 
command enters again, processing in Steps S1 to S13 
is executed, and therefore, the tool is able to be moved 
to and stopped at the desired teaching point 

As described above, according to the present 
invention, when a tool approaches a teaching point set 25 
in advance in the movement command program while 
moving by jog-feed toward a point to be set as a new 
teaching point, the tool is automatically shifted to the 
predetermined teaching point Therefore, an operator is 
able to recognize that the position where the robot 10 is 30 
stopped is a teaching point in the movement command 
program. Further, if the tool is moved by jog-feed from 
that position to a target position (i.a , a point to be set as 
a new teaching point) according to the conventional 
operation, it is possible to perform the correction of a ss 
teaching point Therefore, time required for work is 
reduced. 

Further, according to the embodiment of the 
present invention, when the movement according to the 
jog-feed command inputted by the operator is changed 40 
to the automatic shifting to a teaching point, the direc- 
tion of the tool 12 is changed to the same cfirection as 
the direction specified by the program data of the teach- 
ing point before change of the moving direction. There- 
fore, rt is possible to prevent the tool from interfering with 45 
another part of a workpiece, and work with more accu- 
racy is enabled. 

According to the embodiment of the present inven- 
tion, the tool is automatically shifted toward the teaching 
point at a point of time when the tool approaches the so 
teaching point However, this shifting may also be made 
according to the operator's specific operation on the 
teaching pendant 40. 

Further, in the embodiment of the present invention, 
a description has been given of a case where the tool 12 ss 
of the robot 10 grips a wonVpiece. But, the present 
invention may be applied to a tool such as a welding 
head. 



Claims 

1. A robot movement control device to move a robot 
tool to a predetermined teaching point, comprising: 

a program storage means for storing a program 
to instruct the robot to be moved to the prede- 
termined teaching point; 
a jog-feed command means for instructing the 
robot to be moved by the jog-feed; 
a jog-feed control means for moving said robot 
by the jog-feed in the direction instructed by 
said jog-feed command means; and 
a teaching-point directional movement control 
means for watching the position of the robot 
moved by the jog-feed, and instructing said jog- 
feed control means to shift said robot when it 
approaches any teaching point in the move- 
ment command program, to a teaching point to 
which the robot comes closer. 

2. A robot movement control device according to claim 
1, wherein said teaching-point directional move- 
ment control means shifts said robot tool after said 
tool is reoriented to a posture instructed by said 
program. 

3. A robot movement control device to move a robot 
tool to a teaching point given in advance, compris- 
ing: 

a program storage means for storing a program 
to instruct the robot to be moved to the prede- 
termined teaching point; 
a jog-feed command means for instructing the 
robot to be moved by the jog-feed; 
a jog-feed control means for moving said robot 
by the jog-feed in the direction instructed by 
said jog-feed command means; 
a shifting command means for instructing the 
robot to be shifted to a teaching point given in 
advance; and 

a teaching-point directional movement control 
means for instructing said jog-feed control 
means to shift said robot to a teaching point 
which is the cfosest to the position of said robot 
among the teaching points in said movement 
command program, when said instruction to 
shift the robot is performed. 

4. A robot movement control method, in which: 

a teaching-point move mode is set in a control 
device for controlling a robot; 
when a tool attached to the end of a robot arm 
is moved by the jog-feed toward a target posi- 
tion to which a teaching point is to be corrected 
according to said mode, a numerical control 
device decides, during the movement of the 
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tool by the jog-feed, as to whether or not the 
current position of the tool is within the range of 
a predetermined cfi stance from a programmed 
teaching point; and 

when decided that the current position of the s 
tool is within the predetermined range, the tool 
is forcibly shifted to said teaching point and 
positioned at said target teaching point to be 
corrected. 

10 

5. A robot movement control method according to 
claim 4, wherein when the current position of the 
tool is within the predetermined range of the pro- 
grammed teaching point, the tool is shifted to said 
teaching point after said tool is reoriented to the 75 
direction as is taught in said teaching point. 
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